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Abstract 

A new class of robotic arm consists of a periodic sequence of truss substructures, each 
of which has several variable-length members. Such variable-geometry-truss manipu- 
lators (VGTMs) are inherently highly redundant and promise a significant increase in 
dexterity over conventional anthropomorphic manipulators. This dexterity may be ex- 
ploited for both obstacle avoidance and controlled deployment in complex workspaces. 
The inverse kinematics problem for such unorthodox manipulators, however, becomes 
complex because of the large number of degrees of freedom, and conventional solu- 
tions to the inverse kinematics problem become inefficient because of the high degree 
of redundancy. This paper presents a solution to this problem based on a spline-like 
reference curve for the manipulator’s shape. Such an approach has a number of advan- 
tages: (a) direct, intuitive manipulation of shape; (b) reduced calculation time; and 
(c) direct control over the effective degree of redundancy of the manipulator. Further- 
more, although the algorithm has been developed primarily for variable-geometry-truss 
manipulators, it is general enough for application to a number of manipulator designs. 


1 Introduction 

A new class of robotic arm consists of a periodic sequence of truss substructures containing variable- 
length members. Variable-geometry-truss manipulators (VGTMs) have emerged from various de- 
signs for deployable/controllable trusses for space-based applications [10,12,16]. An example of 
a VGTM is illustrated in Figure 1. The manipulator is a statically determinate truss comprised 
of linear members hinged together at joints. Some members are actuated and can change their 
length; control of these lengths determines the manipulator’s shape as well as the position and 
orientation of the end effector. 

Truss manipulators promise a number of advantages over conventional anthropomorphic 
robot arms and space cranes, not the least of which is a significant increase in dexterity. This 
increased dexterity, however, has a price: a complex and unorthodox kinematic description. This 
paper will outline a kinematic methodology for VGTMs and set up a solution to the general 
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inverse kinematics problem. Furthermore, a new inverse kinematics algorithm — based on spline- 
like reference shape curves — will be presented and compared with the more conventional solution. 


2 Background to the Inverse Kinematics Problem 

The purpose of any robotic arm is to manipulate an end elfector along a desired trajectory; this 
motion depends on the combined action of the manipulator’s actuators. The task of determining 
the correct actuator motion for a given end effector trajectory is the inverse kinematics problem. 

2.1 Direct Kinematics 

The end effector is defined by a set of n e coordinates, x e (t). This vector may contain up to six 
elements: three position and three orientation coordinates. The manipulator’s configuration is 
defined by the vector q(t) containing n, elements representing the manipulator’s internal degrees 
of freedom. In general, we may state the direct kinematics relationship in the form 

x« = f(q) 

n e < n. 

The inequality represents the possibility of redundancy. 

2.2 Differential Kinematics 

In general, the direct kinematics relationship (1) cannot be inverted directly to give the inverse 
kinematics solution. Instead, we resort to differential kinematics [1,15], whereby we arrive at a 
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Figure 2: Geometric Representation of a VGTM 


rate-linear system by expanding the time derivative of x c (f): 

x e («) = J(q)q(<) 


The Jacobian matrix J has dimensions n e x n q . 


dq T 


(3) 

(4) 


2.3 Inverse Kinematics Solution with Redundancy 

For a redundant manipulator, the Jacobian is not square and a solution to (3) is not straightfor- 
ward. A common formulation of a solution takes the form [6,7] 

q = J+x c + (1 - J+ J)q 5 (5) 

JJ+ = I (6) 

The Moore-Penrose pseudoinverse [13], J + , represents a least-squares solution to (3); alternative 
solutions have used weighted pseudoinverses [5]. The vector q, is an arbitrary configuration velocity 
that may be used to minimize a cost function, avoid obstacles or fulfil some other objective [3,8,11]. 
The operator (1 — J + J) projects this velocity onto the null space of J so that the desired motion 
of the end effector is not affected. 


3 Kinematic Description of VGTMs 

Generalized techniques exist to develop kinematic descriptions for conventional anthropomorphic 
manipulators [2]. These techniques, however, are not well suited to truss manipulators. In this 
section, a general kinematic methodology for VGTMs will be developed. 
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3.1 VGTM Geometry 


Figure 2 shows a geometric representation of a truss manipulator. The linear members of the truss 
(actuated and nonactuated) are represented by straight lines having lengths Ik- Embedded in the 
joint mechanisms are the member endpoints, represented by the position vectors r,^. Associated 
with each joint — or truss node — is a node coordinate vector, p t ; each node vector represents a 
fixed point within the joint mechanism that defines the joint’s position in space. Since the truss 
structures are assumed to be statically determinate, we may calculate the orientation of each joint 
given the set of node vectors [pi,p 2 , • •• ,Pjv]> where N is the number of joints in the truss. 

3.2 Configuration Variables 

For conventional robotic arms, the configuration variables are identical to the actuator variables, 
i.e., revolute joint angles and prismatic joint lengths. For VGTMs, however, the actuator variables 
— the nonfixed member lengths — axe unsuitable when writing the direct kinematics; an inter- 
mediate set of variables must be used. The most appropriate choice for configuration variables 
are the node coordinate vectors p t , (i = 1,2, ... , N). These variables have the following properties 
that make them suitable: 

1. Relationships may be found between the node vectors and useful external parameters. For 
instance, we may be interested in the position and orientation of a particular triangular face 
of the truss (where an instrument platform may be attached); these coordinates may be 
found if the node vectors describing the vertices of the triangle are known. 

2. Since the truss is statically determinate, we may calculate the endpoint vectors r,* given 
p i5 (t = 1,2, •• -,N); once the endpoints are known, we may determine the length of each 
actuator. Hence, the actuator coordinates for the truss may be arrived at through this set 
of configuration variables. 

3.3 Kinematic Relationships 

There are three kinematic relationships by which we may determine the node coordinate vectors: 

Explicit External Constraints. This kinematic relationship involves node vectors that are 
known, explicit functions of time; these functions axe defined independently of the truss configu- 
ration and hence are ‘external.’ If there are N c such constrained nodes, we may group them into 
the vector p c such that 

p c = col[p,(0] (7) 

i = 1,2 ,...,N C (8) 

Typically, these form the base nodes of a VGTM. For completeness, we also group the uncon- 
strained node vectors into p: 


( 9 ) 

( 10 ) 
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p = col[pj] 

* = N c +l, N C + 2,...,N 


Implicit External Constraints. This type of constraint describes the relationship of truss 
nodes to a set of external coordinates — such as the end effector coordinates x c — and takes the 
form 

f(p,Pc) = x e(0 (H) 

where f (p,p c ) is a set of functions in the node coordinate vectors. 

Internal Constraints. The n/ nonactuated members of a truss manipulator serve as hard con- 
straints to the motion of the nodes. These internal constraints take the implicit form 


(r,* - r jk ) T (r ik - r jk ) = t\ 

(12) 

r.Jt = r,*(p,p c ) 

(13) 

k = 1,2,. . . , 7i i 

(14) 

i,j = 1,2,..., N 

(15) 


The length of fixed member k is expressed in terms of its endpoint vectors , r,*. If the truss nodes 
are perfect pin joints, the endpoint vectors become identical to the node vectors. 


3.4 Inverse Kinematics 

A unique solution for p may be impossible to determine because of redundancy. To resolve this 
redundancy, we first find rate-linear expressions based on the constraint equations. From the 
implicit external constraints (11), we form 

*Mp,Pc)p + J c(p,p c )pc = (16) 


where 


Ju 

j c 


df 

dp T 

df 


(17) 

(18) 


From the internal constraints we get a set of n/ equations, (k = 1,2, . . .,«/), that take the form 


(r ik — r jk) T [(Jifc.u - Jjfc,u)p + (J«fc,c - J j*,c)p c ] = 0 


(19) 


T _ ^ r ‘* 

'*■“ - dp T 

T - dr ' k 

ik ’ c ~ dpi 


( 20 ) 

( 21 ) 


(N.B. If the nodes are ideal pin joints, the nonzero portions of these Jacobians reduce to identity 
matrices, and we are left with a much simpler set of expressions [18]). We may group these n/ 
equations into a system: 

J S (P>P C )P = x j(p»Pc) (22) 
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(23) 

(24) 

(25) 

(26) 

(27) 

(28) 


4 Inverse Kinematics Using Reference Shape Curves 

In the previous section, a solution to the inverse kinematics problem for VGTMs was found using 
the conventional methods outlined in §2. An alternative solution will now be presented, and a 
comparison will be made to the previous solution to illustrate some advantages associated with 
the new technique. 
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Figure 4: Space curves (Bezier) 


4.1 Basic Concept 

A distinctive feature of the VGTM design is its ability to assume curvilinear shapes [9]. Further- 
more, as illustrated in figure 3, the shape of a truss manipulator may be made to conform exactly 
to an arbitrary space curve in the limit as the number of bays gets large. It is this serpentine 
property of VGTMs that has inspired an inverse kinematics technique based on the modelling of 
the manipulator’s shape using reference shape curves. 

The proposed solution algorithm is as follows: 

1. When solving the inverse kinematics problem, replace the manipulator by a continuous space 
curve that satisfies the same external constraints. 

2. Force the manipulator to track this new desired shape. 

The reference shape curve may be thought of as the next dimensional extension of the end 
effector coordinates, x*: while the latter is defined at a point, the reference curve is a continuous 
coordinate distribution over a line. The second-order case will be a reference shape surface that 
may be used to model plate-like variable geometry trusses. 

The primary reasons for pursuing such a technique are 

1. A simplified, analytic expression for the manipulator’s shape will help in modelling interac- 
tions with the robot’s environment (e.g., collision detection, obstacle avoidance, controlled 
deployment). 

2. Less complex kinematic relations, resulting from the simplified shape model, will improve 
the computational efficiency of the inverse kinematics solution. 
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Figure 5: Coordinate Distribution Associated with Space Curve 

4.2 Type of Curve 

A certain class of space curve, found in computer graphics applications [17], has a number of 
properties that are desirable for this application. These spline-like curves — parameterized by s 
(0 < s < 1) — have the form 

r (M) = ( 29 ) 

t=0 

1 = ^2wi(s) (30) 

«=o 

(31) 

Example of such curves are Bezier curves, B-splines and Beta-splines. Because the weighting 
functions tt?,(s) are a partition of unity, a point on the curve r is a weighted average of the 
control vertices p,. Joining the control verticies sequentially forms an open control polygon that 
approximates the actual shape of the curve; closeness of fit between the control polygon and the 
curve depends on the form of the weighting functions. Figure 4 illustrates this relationship for a 
Bezier curve. 


4.3 Coordinate Distribution 

Associated with the curve is a distribution of position and orientation coordinates, x(s,p). 


x(s,p) 


r ( 5 »p) 

0(s,p) 

col [p,] 


P 
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Figure 6: Partitioning of VGTM 

Figure 5 shows that x(s,p) describes a frame of reference 3~(s, t) that has two properties: 

1. Its origin intersects the curve at r(s,p). 

2. One of its axes is tangent to the curve at the origin. 

Since the tangent is a function of p, two of the three attitude coordinates are explicit functions 
of the control vertices. The third attitude coordinate — representing a torsion about the tangent 
may be specified independently of the control vertices, and hence depends on the parameter s 
alone. 


4.4 Kinematics of a Curve 


The relationship between the control verticies and the overall curve shape allows direct, intuitive 
manipulation of the curve. Hence, the control vertices p will be defined as the configuraton 
variables for the curve. The direct kinematics relation follows from the fact that the coordinate 
distribution, x, is an extension of the original end effector coordinates, i.e., 

x e (t) = x(M) (34) 

The rate-linear kinematic expression for any point on the curve is 


J 4 (s,p)p = x(s,t) 

where J 4 — the curve Jacobian — is defined as 


J*(s,p) = 


drfajp) 

dp 7 

dp? . 


(35) 


(36) 
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Figure 7: Tracking the Curve 


To impose the implicit external constraint expressed in (34), we set 

J*(l|P)P = *e(0 

Following (5), the solution for the curve kinematics becomes 

p = J+x e + (l-J+J.)p. (38) 

As was the case for the general manipulator in §2 and for a VGTM in §3, the vector p, may be 
formulated to achieve a variety of objectives including obstacle avoidance. 

4.5 Tracking the Reference Curve 

The second step in the algorithm is to force the manipulator to track the reference curve. To 
do this, the manipulator is partitioned into smaller VGTMs (see figure 6); each segment may be 
described kinematically in the same manner as the whole VGTM. The implicit external constraints 
x,-(t) corresponding to each segment are then read off the reference curve at discrete points — 
[s 0 , s x , . . . , sn] — called curve nodes , i.e. 

Xj(<) = x(s,-,p) (39) 

The VGTM segments may be solved in one of two ways: 

1. Recursively , whereby the implicit constraints for the fcth bay are given by x(s*,p), and the 
explicit constraints are provided by the ( k — l)st bay, or, 

2. In parallel, whereby each bay is solve independantly using only the implicit information 
provided by the curve. 

Figure 7 shows a manipulator segment tracking a curve that is executing a maneuver. 









Figure 8: Example Maneuver 


4,6 Example Maneuver 

Figure 8 shows sample frames from a 50-step maneuver involving a five-bay VGTM. The arm is 
directed to avoid two cube-shaped obstacles. The inverse kinematics has been solved using the 
reference curve technique; clearly, the technique works adequately in that the desired end effector 
trajectory is tracked, and a safe clearance is maintained between the robot arm and the obstacles. 

4*7 Advantages to the Reference Curve Technique 

Some of the advantages of the reference curve technique are summarized below: 

Improved Computational Efficiency To evaluate any improvement in computation time, 
a test trajectory was designed and both techniques — conventional and reference shape curve 
(recursive) — were used to solve the inverse kinematics for VGTMs of different lengths. The 
maneuver was partitioned into 50 time-steps, and the runs were carried out on an Apollo™ 
DN 4000 workstation. Figure 9 shows a comparison of the run-times for both methods; clearly, 
there is a marked improvement in computational efficiency when using the reference shape curve 
technique. This improvement may be attributed to the recursive nature of the tracking problem, 
as discussed in §4.5. 

Parallel Structure of Problem As stated earlier, the tracking problem may be solved in 
parallel as well. This natural parallel structure makes the reference curve technique conducive to 
a multiprocessing environment [14]; in such an architecture, dedicated processors may be used to 
solve the inverse kinematics of the VGTM segments concurrently, thereby providing a quantum 
improvement in efficiency. 
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Number of Bays 

Figure 9: Run-time Comparison 

Analytical Description of Manipulator Shape An analytical expression for the manipu- 
lator’s shape is helpful when describing robot /environment interactions. An important part of 
many obstacle avoidance routines involves finding the closest point to the obstacle on the manip- 
ulator [4,5,11]. Using the shape curve equation and quickly-converging iterative solvers, we may 
readily solve for these critical points. An analytical description may also be incorporated into a 
mathematical model of the manipulator’s workspace to predict collisions. 

Variable Degree of Redundancy Since the global inverse kinematics problem has been shifted 
from the manipulator to the reference curve, we may specify the degree of redundancy a priori 
by choosing the number of control vertices used to describe the space curve. For instance, if it 
is known that the VGTM is to operate in a very simple, obstacle-free workspace, then only a 
minimum number of degrees of freedom — enough to satisfy the external constraints — need be 
included; conversely, a complex workspace will demand the use of more control vertices. There is 
a limit, of course: it will be impossible for the manipulator to track a shape curve that has more 
degrees of freedom than itself. Yet, this flexiblity in choosing the degree of redundancy may be 
used to reduce computational overhead. 

4.8 Generality 

While developed for application to truss manipulators, the reference curve method is general 
enough to find use as a redundancy resolution technique with more conventional robotic arms. 
The first step in the algorithm remains the same since the kinematics of the reference curve is 
independant of the manipulator. The second step — the tracking problem — may be applied to 
any robotic arm that can be easily segmented into smaller manipulators. 
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5 Conclusions 


A generalized kinematic description has been presented for variable-geometry-truss manipulators. 
From this description, a solution to the inverse kinematics problem was found by conventional 
means. An alternative technique — based on reference shape curves — was developed and applied 
to VGTMs in the hopes of improving the efficiency of the straightforward approach, as well to 
inject some geometric insight in the description of the manipulator’s shape. The new technique 
succeeded in solving the inverse kinematics problem with a significantly decreased computation 
time. Further advantages were noted: 

• Technique is attractive to obstacle avoidance and collision detection applications; 

• Problem structure is applicable to parallel processing; 

• Variable degree of redundancy 

• Generality 

The preliminary success of this new method is encouraging for the development of real-time-control 
robotic facilities based on truss manipulators. 
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